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© Regelsystem fur elektrische Antriebe und Verfahren zur Bahnregelung 

® Die Erfindung betrifft ein Regelsystem fur elektrische 
Antriebe, mit einem Beobachter (1), einem ersten Regel- 
verstarker (4), einem zweiten Regelverstarker (5) und ei- 
nem dritten Regelverstarker (6), wobei die Ausgangssi- 
gnale der Regelverstarker zum Antriebseingangssignal 
zusammengesetzt werden, und die Zusammensetzung 
der Ausgangssignale der Regelverstarker erfolgt, indem 
ein zweiter Differenzbildner (11) ein Differenzsignal blldet 
und dieses dem zweiten Regelverstarker (5) einspeist, 
und ein dritter Differenzbildner (12) ein Differenzsignal 
bildet und dieses dem dritten Regelverstarker (6) ein- 
speist. Die Erfindung betrifft auch ein Verfahren zur Bahn- 
regelung eines elektrischen Antriebs, dessen mogliche 
Bewegungsbahnen in einem festen Koordinatensystem 
der Dimension n liegen. Zur Ermittlung des Stellgrofcen- 

■ vektors wrid eine Transformation in ein mitbewegtes Ko- 

, ordinatensystem durchgefuhrt. 
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Beschreibung 

Die vorliegende Erfindung betrifft ein Regelsystem fur elektrische Antriebe, mil einem Beobachter, der ein erstes An- 
triebsausgangssignal und ein erstes Antriebseingangssignal empfangt und ein erstes Zustandsanderungssignal und ein 
5 zweites Zustandsanderungssignal ausgibt; und mit einem ersten, einem zweiten und einem dritten Regelverstarker, deren 
Ausgangssignale zum Antriebseingangssignal zusammengesetzt werden. 

Die Erfindung betrifft weiterhin ein Verfahren zur Bahnregelung von elektrischen Antrieben, welches zur Ansteuerung 
eines Antriebs verwendet wird, um diesen zu veranlassen, eine vorgegebene Bewegungsbahn abzufahren. 

Aus dem Stand der Technik sind verschiedenc Regelungen fur elektrische Antriebssystemc bekannt, die insbesondere 
10 der Lageregelung bzw. Positionsregelung dienen. Damit ein ein- oder mehrachsiger Antrieb eine vorgegebene Bahn ab- 
fahrt, beispielsweise um eine Materialbearbeitung mit einem angeschlossenen Werkzeug auszufuhren, generieren die be- 
kannten Regelsysteme eine Folge von Positionssollwerten (Solltrajektorie) und versuchen den Antrieb derart anzusteu- 
ern, da!3 dieser moglichst verzogerungsfrei diese Position ssollwerte anfahrt. Die Tatsache, daB die Antriebe den Solltra- 
jektorien nicht verzogerungsfrei folgen konnen, bedingt zwangslaufig systematische Fehler hinsichtlich der kincmati- 
15 schen Parameter und Unsynchronitaten zwischen mchrcren Achsen dcs Antriebssystems. Sofern mehr als eine Achse an- 
zusteuern ist und komplexere Bewegungsbahnen beschrieben werden mussen, fiihrt dies bei der Berechnung der Solltra- 
jektorien zu einem erheblichen Rechenaufwand, der bei der Koordinierung mehrerer Antriebsachsen die Leistungsfahig- 
keit eines im Regelsystem integrierten Prozessors schnell uberschreiten kann. Die bekannten Regelsysteme bereiten auch 
besondere Schwierigkeiten, wenn wahrend des Abfahrens der vorgegebenen Bewegungsbahn un vorhergesehene Storun- 
20 gen auftreten, die beispielsweise eine von mehreren Antriebsachsen QbcrmaBig abbremsen. In solchen Fallen ist es fur 
_ . das Regelsystem zumeist nicht moglich,-den plotziich-groBer werdenden -Unterschied-zwischen Positionssollwert und" 
tatsachlicher Position des Antriebs unter Einhaltung von vorgegebenen Grenzparametern (rnaxiinale Geschwindigkeit, 
maximale Beschleunigung, maximale Anderung der Beschleunigung) rechtzeitig wieder auszugleichen. 

Aus dem Artikcl "Regelung eines integrierten Mehrkoordinatenantricbs", E. Saffert u. a., Tagungsunterlagcn des 41. 
25 International wissenschaftlichen Kolloquiums der TU Ilmenau, 23.-26. September 1996, ist eine Regelung bekannt, 
die einen sogenannten Beobachter enthalt. In einen solchen Beobachter ist ein Systemmodell des Antriebssystems iin- 
plementiert, wobei die Modellierung zum Ziel hat, daB das Systemmodell mit dem echten System weitgehend iiberein- 
stimmt. Durch den Beobachter konnen somit Zustandsvariablen fur den Regelalgorithmus bereitgestellt werde, die am 
echten System weder gemessen noch unmittelbar aus vorhandenen MeBwerten berechnet werden konnen. 
30 Ein vergieichbares Regelsystem ist auch in dem Artikel "Planar Multi-coordinate Drives", E. Saffert u. a., Tagungsun- 
terlagen PCLM '98 Nurnberg, 26-28. Mai 1998 angegeben. Diese Regelsysteme lassen sich auch als inkrementelle Zu- 
standsregelung bezeichnen, die unten in Bezug auf Fig. 1 naher erlautert wird. Der Nachteil dieser bekannten Regelung 
besteht u. a. darin, daB groBere Regelabweichungen nur schlecht verarbeitet werden konnen oder zu unerwiinscht hohen 
Abweichungen der sonstigen Parameter des Bewegungsablaufes fiihren. 
35 Es besteht daher ein Bedarf an einem verbesserten Regelsystem und einem Verfahren zur Bahnregelung, welche die 
Nachteile des Standes der Technik vermeiden und den Bewegungsablauf in einem Antriebssystem mit moglichst gerin- 
gen Abweichung von der vorgegebenen Bahn erzielen. 

Diese und weitere Aufgaben werden einerseits durch das im Anspruch 1 angegebenen Regelsystem und andererseits 
durch das im Anspruch 8 angegebene Verfahren gelost. 
40 Das erfindungsgemaBe Regelsystem bietet den Vorteil, daB aufgrund der detaillierteren Modellierung des Antriebssy- 
stems im Beobachter und der Verwendung zusatzlicher Regelelemente die kinematischen Parameter der Bewegungsab- 
laufe aus der gemessenen Position heraus mit hoher Genauigkeit berechnet werden konnen, ohne daB zusatzliche Senso- 
ren erforderlich sind. Dabei ist es besonders vorteilhaft, daB die MeBdaten innerhalb der erfindungsgemaBen Kaskaden- 
regelungsstruktur zur Korrektur von Fehlern in den kinematischen Parametern des Bewegungsablaufs verwendet wer- 
45 den, bevor es zu signifikanten Bahnfchlern und Unsynchronitaten kommt. 

Bei einer abgewandelten Ausfiihrungsform des Regelsystems liefert der Beobachter zwei weitere Regelsignale, wel- 
che die Zustandsparameter eines elasti schen Systems beschreiben. Um kompliziertere Antriebssysteme exakt regeln zu 
konnen, ist es nicht ausreichend, diese als eine punktformige Lastmasse zu betrachten. Vielmehr mussen die meisten Sy- 
steme als eine Massen-Feder-Kombi nation beschrieben werden, um die elasti schen Eigenschaften des Systems zu be- 
50 riicksichtigen. In eine genauere Regelung mussen daher der jeweilige Verformungsweg und die Verformungsgeschwin- 
digkeit des Federelements einbezogen werden. 

Bei einer abgewandelten Ausfiihrungsform werden zusatzlich Sollwerte fiir die Geschwindigkeit und die Beschleuni- 
gung in das Regelsystem eingespeist und dort in erfindungsgemaBer Weise verarbeitet. Damit ist es moglich, eine Vor- 
steuerung der Dynamik des Betriebssystems auszufuhren. 
55 Eine nochmals abgewandelte Ausfiihrungsform des Regelsystems ermoglicht die Beschleunigungsvorsteuerung die 
Kompensation auftretender Fliehkrafte wahrend der Steuerung des Antriebssystems. Dazu wird die Beschleunigung an- 
gepaBt auf die auftretenden Fliehkrafte vorgewahlt. Dieses Regelsystem ist besonders nutzlich, wenn Kreise oder Kreis- 
bahnsegmente von dem Antriebssystem abgefahren werden sollen. 

Das erfindungsgemaBe Verfahren zur Bahnregelung kann vorteilhaft in solchen Regelsystemen aber auch bei einer 
60 Vielzahl anderer Regelsysteme eingesetzt werden. ErfindungsgemaB erfolgt die Bahnregelung durch die Transformation 
der Regelabweichung in ein mitbewegtes Koordinatensystem, wodurch der gesuchte StellgroBenvektor besonders ein- 
fach bestimmt werden kann. Nach Ermittlung des StellgroBenvektors durch das Regelsystem erfolgt schlieBlich eine 
Riicktransformation in das feste Koordinatensystem des Antriebssystems. 

Weitere Einzelheiten, Vorteile und Weiterbildungen ergeben sich aus der nachfolgenden Beschreibung bevorzugter 
65 Ausfuhrungsformcn, unter Bezugnahmc auf die Zeichnung. Es zeigen: 

Fig. 1 ein Blockschaltbild, welches die allgemeine Struktur eines sogenannten Beobachters in Verbindung mit einem 
realen System nach dem Stand der Technik darstellt; 

Fig. 2 ein Blockschaltbild, welches die allgemeine Struktur einer inkrementellen Zustandsregelung nach dem Stand 
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der Technik zeigt; 

Fig. 3 ein Blockschaltbild, welches ein erfindungsgemaBes Regelsystem gemaB einer ersten Ausfuhrungsform dar- 
stellt; 

Fig. 4 ein Blockschaltbild einer zweiten Ausfuhrungsform des Regelsystems, bei welchem zusatzlich die Vbrsteue- 
rung der Dynamik des Antriebssystems moglich wird; 5 

Fig. 5 drei Diagramme, die das Verhalten eines Antriebssystems kennzeichnen, welches ohne und mit dem Regelsy- 
stem gemaB Fig. 4 angesteuert wird; 

Fig. 6 ein Blockschaltbild einer abgewandelten Ausfuhrungsform des Regelsystems, die sich insbesondere zur Rege- 
lung elastischer Systemc eigne!; 

Fig. 7 eine Modelldarstellung eines elastischen Antriebssystem, fur welches das Regelsystem gemaB Fig. 6 an wend- 10 
bar ist; 

Fig. 8 eine Darstellung der Beziehung zwischen einem festen xy-Koordinatensystem des Antriebssystem und einem 
transformierten, bewegten ze-Koordinatensystem zur Durchfuhrung der erfindungsgemaBen Bahnregelung; 

Fig. 9 einen Abiaufplan der prinzipiellen Verfahrensschritte zur erfindungsgemaBen Bahnregelung in einem Mehrko- 
ordinatcnantrieb; 15 

Fig. 10 ein Blockschaltbild eines Regelsystems, welches die erfindungsgemaBe Bahnregelung ausfuhrt; 

Fig. 1 1 eine Prinzipskizze des Ablaufs der Bahnregelung bei der Bewegung entlang eines Kreisbogensegments. 

Fig. 1 zeigt ein Blockschaltbild einer Kombination zwischen einem zu regelnden System und einem sogenannten Be- 
obachter, wie sie aus dem Stand der Technik bekannt ist. Bei der Versendung eines Beobachters zur Regelung eines Sy- 
stems geht man davon aus, daB die Anderungcn der Zustandc des Systems vom Beobachter identisch simuliert werden 20 
- konnen, wenn die EingangsgroBen bekannt sind und die Systemparameter vollstandig in "den Beobachter implerneriliert 
wurden. Fur die nachfolgenden Betrachtungen handelt es sich bei dem System urn ein Antriebssystem, insbesondere ei- 
nen elektrischen Antrieb, und die von dem Antrieb ausgefiihrten Bewegungen werden als Zustandsanderungen des Sy- 
stems verstandcn. Der theoretische Ansatz, daB sowohl EingangsgroBen als auch Systemparameter exakt bekannt sind, 
wird in der Praxis nur bedingt erfiillt. Daher mtissen im Regelsystem die meBbaren AusgangsgroBen des Systems vor- 25 
hergesagt (beispielsweise durch eine geeignete Berechnung) und anschlieBend mit den lalsachlich gemessenen Aus- 
gangsgroBen verglichen werden, Auf diese Weise wird ein Fehler bestimmt, der dann in das Regelsystem als Korrektur- 
term K eingefuhrt wird, urn durch Berucksichtigung dieses Korrekturtenns die Reduzierung des Fehlers zu erreichen. 
Das in Fig. 1 dargestellte System kann mathematisch durch eine zeitdiskrete Zustandsraumbeschreibung wie folgt defi- 
niert werden: ~ ' 30 

*k+i = Ax k + Bu k 

yk = Cx k 

Da in dieser Patentanmeldung ubliche Bezeichnungen fur regelungstechnische Variablen verwendet werden, einzelne 
dieser Variablen aber auch zur Bezeichnung von Koordinatensystemen dienen, sei zur Klarheit die Bedeutung der Varia- 
blen expiizit angegeben: 
im regelungstechnische Sinne gilt: 

y = Vektor der RcgelgroBcn 40 

x = Vektor der ZustandsgroBen 

u = Vektor der StellgroBen 

e = Vektor der Regelabweichungen 

fur die Koordinatensystem der Bahnregelung gilt: 

x = x-Vektor des (festen) xy-Koordinatensystems 45 

y = y- Vektor des (festen) xy-Koordinatensystems 

z = z- Vektor (Richtungsvektor) des (bewegten) ze-Koordinatensystems 

e = e- Vektor (Abweichungsvektor) des (bewegten) ze-Koordinatensystems 

Die Bezeichnungen werden auch als Index verwendet und kennzeichnen dann die Komponente eines Vektors, die in 
Richtung des entsprechenden Koordinaten vektors weist, z. B. 50 
v c = Geschwindigkeit in Richtung des e- Vektors 

Da in der Praxis zumeist mehrere EingangsgroBen und AusgangsgroBen verarbeitet werden mtissen, werden die Ein- 
gangsgroBen als Vektoren angegeben und die Parameter des Systems werden durch Systemmatrizen reprasentiert Zur 
speziellen Definition des Beobachters mtissen die Schatzwerte A*, B* und C*, welche mit gewissen Abweichungen die 
Systemmatrizen A, B und C reprasentieren, bestimmt und weiterhin ein Korrekturvektor K festgelegt werden. Die De- 55 
tails des Aufbaus und des Einsatzes eines solchen Beobachters sind aus dem Stand der Technik bekannt, so daB hier keine 
weiteren Erlauterungen angegeben werden. Bei der Verwendung des Beobachters im Regelsystem fur ein Antriebssy- 
stem ist jedoch darauf zu achten, daB die Zustandsvariablen bei der dem Beobachter zugrunde liegenden Modellierung so 
gewahlt werden, daB sie den spater durch die Regelung zu beeinflussenden HilfsregelgroBen entsprechen. So ist es z. B. 
bei elastischen Systemen (siehe unten) hilfreich, statt der Motorgeschwindigkeit und -position, die Verfonnungsge- 60 
schwindigkeit und Verformung der Elastizitat als Zustands variable zu verwenden. 

Fig. 2 zeigt ein Blockschaltbild einer inkrementellen Zustandsregelung nach dem Stand der Technik, die einen Beob- 
achter verwendet. Bei Antriebssystemen, wie sie beispielsweise fur Positionierungsaufgaben oder bei der Werkzeug- 
steuerung verwendet werden, besteht das allgemeine Regelungsproblem darin, die Position s(t) als Funktion der Zeit ei- 
ner vorgegebencn Funktion w(t) folgen zu lassen. In der Regcl ist die Funktion w(t) nicht expiizit angegeben sondern 65 
uber die folgenden Nebenbedingungen definiert: 



w(0) = 0, w(Q = w e , Ivl < v max , loci < (W, !rl < r max 
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In einem praktischen Anwendungsfall soli beispielsweise ein Laserwerkzeug mil einer bestimmten Geschwindigkeit 
auf einem Materialstuck entlang fahren, urn entsprechende Bearbeitungen (z. B. Schneiden, SchweiBen) auszufiihren. 
Bei Regelsystemen nach dem Stand der Technik wird das angegebene Regelungsproblem dadurch gelost, daB in einem 
ersten Schritt die Funktion w(t) von einem sogenannten Sollwert- oder Bahngenerator durch Losen der inversen Kine- 
matik berechnet wird. Der verwendete Regler hat dann eine Folgeregelung auszufiihren, urn die gewunschte Bewegungs- 
bahn durch das Antriebssystem zu realisieren. Damit der Regler seine Funktion ausfiihren kann, ist eine gewisse Rege- 
labweichung zwingend erforderlich, die zu einem sogenannten Schleppfehler fuhrt, d. h. die Istposition des Antriebs 
wird der berechneten Sollposition urn diesen Schleppfehler nacheilen. Insbesondere bei kompliziertercn Bewegungsbah- 
nen ftihrt dieser Schleppfehler zu teilweise erheblichen Abweichungen zwischen der vorgegebenen Funktion w(t) und 
der tatsachlich ausgefuhrten Bewegung. Wie oben dargelegt wurde, ist es fur eine Regelung unter Verwendung eines Be- 
obachters erforderlich, das zu regelnde System geeignet zu modellieren, d. h. die Zustande des Systems vorteilhaft zu 
wahlen. Geht man vom dem einfachen Fall der Bewegung eines starren Korpers (Lastmasse) aus, kann die Motorkraft 
F M wie folgt beschrieben werden: 



M * 1 



20 



25 



wobei k M die Motorkonstante und 
i der Motorstrom ist. 

Fur die Bewegung eines_solchen Antricbssystems in einer Achse gilL diefqlgcnde Gleichung: 
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y = [01]-x 

u = i (StellgroBe u ist der Motorstrom i), 

wobei d die Dainpfungskonstante des Antriebs ist. 

Das modellierte System hat somit die beiden Zustande Geschwindigkeit v und Position s. Bei der an sich bekannten in- 
krementellen Zustandsregelung wird nicht der Zu stands vek tor 



x k = 



40 



sondern seine Anderung 



Ax, = x k - x k _ x = 



verwendet. 

Aufgrund von Linearitatsbeziehungen kann diese Anderung des Zustandsvektors mit den normalen Beobachterglei- 
45 chungen berechnet werden, wenn statt der normalerweise verwendeten Signale 
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Uk = ik und yk = Sk 
deren Anderungen 
Au k = ik - ik-i und Ay k = s k - Sk_ L 



55 



60 



benutzt werden. 

Werden Geschwindigkeit und Beschleunigung durch Differenzquotienten angenahert, d. h. 

V, - V,.. 



und 



' jg — 1 



bei einer Abtastzeit Ts, dann kann die Anderung des Zustandsvektors 



65 als Vcktor der Beschleunigung und Geschwindigkeit aufgefaBt werden. Werden nun die Skalicrung der Zustande bei der 
Modellierung und die Abtastzeit passend gewahlt, z. B. v in mm/s und s in mm, dann sind die Einheiten von 
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— • Ax, 

T 

bei einer Abtastzeit von T s = 0,001 s gerade m/s 2 und m/s. 5 

Zum besseren Verstandnis wird nachfolgend kurz die aus dem Stand der Technik bekannte inkrementelle Zustandsre- 
gelung gemafi Fig. 2 erlautert. Ein Beobachter 1 empfangt zwei Signale du und dy von zwei Differenziereinheiten 2. Die 
Differenziereinheiten 2 (Sample & Difference = Abtasten und Differenzieren) berechnen die Anderungen ihrer jeweili- 
gen Eingangssignale u und y, und stellen hier die Anderungen der Antxiebsstroms du bzw. der Position dy an den Beob- 
achter bereit. Der Beobachter 1 ermittelt unter Verwendung der oben beschriebenen Modellierungdie entsprechende Zu- l o 
standsanderung, die als Beschleunigungssignal a und Geschwindigkeitssignal v ausgegeben wird. Ein erster Differenz- 
bildner 3 bildet ein Differenzsignal aus den EingangsgroBen y und w und gibt dieses Differenzsignal an einen ersten Re- 
gelverstarker 4 ab. Die Ausgangssignale des Beobachters v und a werden an einen zweiten Regelverstarker 5 bzw. einen 
dritten Regelverstarker 6 gesandt, wobei die drei Regelverstarker 4, 5 und 6 ihre Ausgangssignale an einen Summierer 7 
liefern. Der Differenzbildner 3, die Regelverstarker 4, 5, 6 und der Summierer 7 realisieren in dieser Schaltungsstruktur 15 
die folgende Reglergleichung: 

Au k = kAx k + le k = k(l) a k + k(2) v k + l(y k - w k ) 

... Der erste Summierer 7 Iiefert sein : Ausgangssjgnal_an einen zweiten Suminierer 8, der als wei teres Eingangssignal den 20 
Ausgang von einem Speicher 9 erhalt. Der zweite Summierer 8, der Speicher 9 und ein erster Begrenzer 10 (umax) rea- 
lisieren ihrerseits die Reglergleichung: 



Uk = Uk-i + Au k unter der Nebenbedingung !u k l < u n 



~ a Soli 



m 



M 



Bei der in Fig. 4 dargestellten Ausfuhrungsform werden Vbrgabewerte fiir die Sollgeschwindigkeit und die Sollbe- 
schleunigung in die Kaskadenstruktur eingefuhrt. Somit wird der gewunschte Vorsteuerstrom unmittelbar vom Regel- 
kreis erzeugt, wobei eventuelle Parameterfehler beriicksichtigt werden konnen. Um dies zu realisieren werden der zweite 
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Hiermit steht am Ausgang der inkrementelien Zustandsregelung ein Stromsignal zur Verfiigung, welches dem An- 
triebssystem eingespeist wird, um dieses zu einer Bewegung auf der vorgegebenen Bahn mit den weiteren vorgegebenen 
Parametern zu veranlassen, wobei die Regelung bestrebt ist, den o. g. Schleppfehier moglichst klein zu halten, anderer- 
seits prinzipbedingt nicht in der Lage sein wird, den Schleppfehier vollstandig auszugleichen. 

Fig. 3 zeigt ein Blockschaltbild eines erfindungsgemaBen Regelsystems, welches auch als virtuelle Kaskadenregelung 30 
bezeichnet werden kann. Die Elemente, die bereits aus dem in Fig. 2 gezeigten Blockschaltbild bekannt sind, wurden mit 
den gleichen Bezugsziflern bezeichnet. In Abwandlung von dem bekannten Regelsystem Iiefert der Beobachter 1 die der 
Geschwindigkeit und der Beschleunigung entsprechenden Ausgangssignale nicht direkt zu den Regelverstarkern son- 
dern jeweils in einen zweiten DifTerenzbildner 11 (ev) bzw. einen dritten Differenzbildner 12 (ea). Im Gegensatz dazu ist 
der Summierer entfallen, da die Regelverstarker kaskadiert angeordnet sind. Beim ersten Differenzbildner 3 wurden die 35 
Vorzeichen der Eingange vertauscht, so daB dieser nunmehr den Positionsfehler (ey) mit verandertem Vbrzeichen Iiefert. 
Durch die neu eingefugten zweiten und dritten Differenzbildner 11, 12 werden die veranderten Vorzeichen beriicksich- 
tigt. Aufgrund des vorgeschalteten Differenzbildners 3 Iiefert der erste Regelverstarker 4 (ky) einen verstarkten Positi- 
onsfehler, der einer Sollgeschwindigkeit vsoll entspricht. Der zweite Regelverstarker 6 (kv) Iiefert einen verstarkten Ge- 
schwindigkeilsfehler, der einer Sollbeschleunigung asoll entspricht und der dritte Regelverstarker 6 (ka) Iiefert den Ver- 40 
starkten Beschleunigungsfehler, der dem Sollruck rsoll also der Sollanderung der Beschleunigung entspricht. Die Hilfs- 
groBen der Regelkaskade a und v werden vom Beobachter, d. h. virtuell bereitgestellt. Die Verstarkungsfaktoren der drei 
Regelverstarker 4, 5, 6 wurden in dem gezeigten Blockschaltbild zur Klarheit mit den GroBen bezeichnet, die sie verstar- 
ken. Dabei gelten die folgenden Zusammenhange: 

45 

k y = l/k(2) Verstarkung des Position sfehlers 

k v = k(2)/k(l) Verstarkung des Geschwindigkeitsfehlers 

k a = - k(l ) Verstarkung des Beschleunigungsfehlers 50 

Weiterhin werden die Ausgangssignale der Regelverstarker vor der weiteren Verarbeitung unmittelbar in zugeordnete 
Begrenzer eingespeist. Ein zweiter Begrenzer 13 (vmax) empfangt das Signal vom ersten Regelverstarker 4, ein dritter 
Begrenzer 14 (amax) empfangt das Signal vom zweiten Regelverstarker 5 und ein vierter Begrenzer 15 (rmax) empfangt 
das Signal vom dritte Regelverstarker 6. Die Begrenzer 13, 14, 15 gewahrleisten, daB die von den Regelverstarkern ge- 55 
lieferten Sollwerte und damitdie entsprechenden GroBen selbst, die Nebenbedingungen (siehe oben) einhalten. 

Fig. 4 zeigt ein Blockschaltbild einer abgewandelten Ausfuhrungsform des erfindungsgemaBen Regelsystems, wel- 
ches zusatzlich die Mogiichkeit einer Vorsteuerung aufweist. Prinzipiell ist es bekannt, parallel zum eigentlichen Regler 
eine StellgroBe bereitzustellen, um den genannten Schleppfehier zu minimieren. Bei genauer Kenntnis der Parameter des 
Systems laBt sich beispielsweise der Vorsteuerstrom fur die Beschleunigung aus der Sollbeschleunigung jfc oU wie folgt 60 
bestimmen: 
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und der dritte Differenzbiffll^lr und 12' um einen weiteren addierenden Eingang e^KK 7 an welchem das Geschwin- 
digkeitsvorsteuersignal bzw. das Beschleunigungsvorsteuersignal eingespeist werden. 

Einer derartige Vorsteuerung ist beispielsweise hinsichtlich der Radialbeschleunigung sinnvoll, wenn von dem An- 
triebssystem kreisbogenformige Bewegungsbahnen ausgefiihrt werden sollen. In einem derartigen Anwendungsfall muB 
der Regelkreis eine Radialbeschleunigung erzeugen, obwohl andererseits angestrebt wird, daB sowohl der Radialfehler 
als auch die Radialgeschwindigkeit gleich Null sind. Es gilt: 
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wobei v t dem Beobachter des Tangentialregelkreises und 

r der Beschreibung des abzufahrenden Kreisbogens entnommen werden konnen. 

Fur den speziellen Fall, daB eine Kreisbahn oder ein Kreisbahnsegment vom Antrieb befahren werden soil, ist eine Be- 
schleunigungs vorsteuerung besonders nutzlich, wenn gleichzeitig die weiter unten detaillierter dargestellte erfmdungs- 
gernaBe Bahnregelung zum Einsatz koinrrit. 

Fig, 5 zeigt drei Diagramme, die die Wirkung der Verwendung einer zusatzlichen Vorsteuerung gemaB dem in Fig. 4 
dargestellten Blockschaltbild auf die GroBe des Schleppfehlers deutlich machen. Das Diagramm a) zeigt die Funktion 
der Position uber der Zeit, wobei die Kennlinie 20 den Verlauf des berechneten Sollwertes angibt, wahrend die Kennlinie 
21 den Verlauf der tatsachlich vom Antriebssystem eingenomrnenen Position darstellt. Zur Verdeutlichung ist auBerdem 
der Betrag des Schleppfehlers durch eine Hilfslinie 22 cingezcichnet, der sich aus dem Abstand zwischen berechnetem 
"SollwerUindeingelioimneTierPositio 
zu 30% des Gesamtverfahrweges betragen kann. Im Diagramm b) ist der Schleppfehler als Funktion der Zeit eingetra- 
gen, wenn eine Geschwindigkeitsvorsteuerung vorgenommen wird. Tin Diagramm c) ist wiederum der Schleppfehler als 
Funktion der Zeit cingetragen, unter der Bedingung, daB eine Geschwindigkeits- und eine Bcschleunigungsvorsteuerung 
in das Regelsystem eingespeist werden. Wie aus den Diagrammwerten erkennbar ist, reduziert sich der Schleppfehler bis 
auf etwa 0,05% des Verfahrweges. 

Fig. 6 zeigt das Blockschaltbild einer weiteren Ausfuhrungsform des Regelsystems. Das in seiner Grundstruktur be- 
reits erlauterte Regelsystem wurde bei dieser Ausfuhrungsform erweitert, um die Einfliisse des elastischen Verhaltcns ei- 
nes reellen Antriebssystems zu berucksichtigen. Dieses System wird hier beispielhaft fur den allgemeineren Fall ange- 
geben, daB im Regelsystem mehr als zwei Zustandsvariablen zu berucksichtigen sind. Es sind dabei auch Systeme denk- 
bar, die vier, acht oder mehr Zustandsvariablen aufweisen. Die Reglerstruktur wird jedoch immer in der gleichen Weise 
zu erweitern sein, wie dies nachfolgend in Bezug auf ein elastisches System dargestellt wird. Von einem derartigen ela- 
stischen System muB bei einer moglichst genauen Regelung bei sehr vielen praktisch realisierten Antrieben ausgegangen 
werden. Bisherige Regelsysteme berucksichtigen diese Konstellation jedoch nicht oder nur unzureichend. Elastische 
Elemente liegen bereits bei einem Antriebssystem vor, welches einen Rotation smotor verwendet, der eine Last uber eine 
elastische Spindel oder einen elastischen Zahnriemen antreibt. 

Zum Verstandnis der nachfolgend genannten Gleichungen, welche die Zustande dieses Antriebssystems beschreiben, 
wird auf die Fig. 7 verwiesen, in der ein mechanisches Modell eines solchen elastischen Systems gezeigt ist. Insbeson- 
dere ist die Feder-Dampfungs-Kopplung zwischen dem Motor und der Last zusatzlich zu berucksichtigen. Die oben ge- 
nannte Zustandsgleichung fur ein starres System erweitert sich damit wie folgt: 
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Um die erflndungsgemaBe virtuelle Kaskadierung auszufuhren, werden die Zustande des Motors (Motorposition Sm 
und Motorgeschwindigkeit v M = s M ) durch die Zustande der Elastizitat (Verformung s D und Verformungsgeschwindig- 
keit vd = so) ersetzt, in dem eine Zustands transformation ausgefiihrt wird: 

55 So = Sm - Sl 
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Damit ergibt sich: 
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Wie aus dem in Fig. 7 gezeigten Modell ersichtlich ist, kann die zur Beschleunigung der Last erforderliche Kraft nur 
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aufgebracht werden, wenn^Rwischengekoppelte Elastizitat deformiert wird. Wird dUffTden entsprechcnden Begren- 
zer eine maximale Lastbeschleunigung vorgegeben, ist dies somit gleichbedeutend mit der Vorgabe einer maximalen De- 
formation des Federelements. In dem Blockschaltbild gemaB Fig. 6 sind daher an den entsprechenden Blocken doppelte 
Bezeichnungen angeLragen. Die durch das Regelsystem realisierte Wirkungskette laBt sich verbal wie folgt darstellen: 
Lastposition — * Lastgeschwindigkeit — * Lastbeschleunigung/Deformation — ► Deformationsgeschwindigkeit — ► Defor- 
mationsbeschleunigung — ► Deformationsruck 

Der besondere Vorteil dieses Regelsystems besteht darin, daB die zwangslaufig auftretenden Deformationen in der Re- 
gelung erfaBt und von dieser berucksichtigt werden konnen. Bei Regelungsverfahren nach dem Stand der Technik fuhren 
die vorhandenen Deformationen zu unerwiinschten Schwingungen, die durch die Regelung nicht aktiv ausgeglichen wer- 
den und damit insbesondere die moglichen Geschwindigkeiten und Beschleunigungen des geregelten Antriebssystems 
deutlich begrenzen. Die praktische Umsetzung im Regelsystem erfolgt durch Hinzufugung von zwei weiteren Differenz- 
bildnern 50 und 51 sowie zwei weiteren Regelverstarkern 52 und 53, die in der bereits erlauterten Weise in die Regelkas- 
kade eingefugt werden. Dabei ist es zweckmaBig nach jedem zusatzlichen Regelverstarker auch zusatzliche Begrenzer 
54 und 55 einzufiigcn, urn die maximalen Vorgabcn fur die RegelgroBcn einzuhaltcn. Der ubrige Aufbau des Regelsy- 
stems enLspricht den bereits vorher beschriebencn Ausfuhrungsformcn. 

Dem gemeinsamen Ziel, eine verbesserte Regelung eines Antriebssystems bereitzustellen, dient auch das im Anspruch 
8 angegebene Verfahren zur Bahnregelung von elektrischen Antrieben. Dieses Verfahren zur Bahnregelung kann insbe- 
sondere vorteilhaft bei Anvvendung des oben beschriebenen Regelsystems eingesetzt werden, jedoch kommt auch eine 
Implementierung in anderen Regelsystemen in Betracht. 

Die erfindungsgemaBe Bahnregelung beruht auf dem Ansatz, daB alle kinematischen GroBen der Bewegung eines Sy- 
stems (sowohhin der Ebene~als auch'im'Raum); also die Position s, die Geschwindigkeit v, die Beschleunigung a, der 
Ruck r usw., VektorgroBen sind, die am Schwerpunkt des bewegten Systems angreifen. Unter Bcachtung dieser \braus- 
setzung konnen diese GroBen, die eigentiich in Bezug auf das feste Koordinatensystem des Antriebs definiert sind, in be- 
liebige gcdrehte bzw. mitbewegte Koordinatcnsysteme transformiert werden. 

Das in Fig. 8 dargestellte Diagramm verdeutlicht die Zeriegung eines Geschwindigkeitsvektors v in die Komponenten 
v x und v y in dem festen xy-Koordinatensystem, ais auch die mogliche Zeriegung in die Komponenten v e und v z in einem 
transformierten, gedrehten ze-Koordinatensystem. Da jeweils die Ordinate und die Abszisse des jeweiligen Koordinaten- 
systems senkrecht zueinander stehcn, ist die Verdrehung des bewegten ze-Koordinatensystems gegenuber dem festen xy- 
Koordinatensystem durch die Angabe eines der beiden Vektoren z oder e im xy-Koordinatensystem eindeutig bestimmt. 
Der jeweils andere Vektor laBt sich durch einfache Drehung um 90° berechnen. 

Ist zum Beispiel 
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bekannt, so ist 
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L e y. 
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Umgekehrt laBt sich der z- Vektor aus dem e- Vektor berechnen. 
r 



Z = 
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45 



ZweckmaBigerweise werden die beiden Koordinaten vektoren normiert, so daB ihre Lange gleich 1 ist, bzw.: 

z 2 x +z 2 y =e 2 x +e 2 y = \. 

Die Transformation des v- Vektors vom feststehenden xy-Koordinatensystem, in dem die Messung erfolgt, in das ze- 
Koordinatensystem, in dem die Regelung erfolgt, ergibt sich dann nach foigenden Gleichungen: 



L v vj 



50 



55 



und 



60 



v e = e T v xy = [e x e y ] 

bzw. zusammengefaBt: 
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Die prinzipiellen Verfahrensschritte zur Bahnregelung in Mehrkoordinatenantrieben sind in dem in Fig. 9 gezeigten 
Ablaufplan dargestellt. In einem ersten Hauptschritt 60 muB die Bahn durch Referenzpunkte beschrieben werden. In ei- 
nem zweiten Hauptschritt 61 wird ein geeignetes bewegtes Koordinatensystem bestimmt. AnschlieBend erfolgt in einern 
dritten Hauptschritt 62 die Transfcn nation der Regelabweichung in bewegte Koordinaten im bewegten Koordinatensy- 
stem. In einem vierten Hauptschritt 63 werden durch einen Richtungsregler und einen Abweichungsregler die notwendi- 
gen StellgroBen bestimmt. AbschlieBend werden die ermittelten StellgroBen in einen funften Hauptschritt 64 in feste Ko- 
ordinaten des festen Koordinatensy stems zurucktransformiert, urn sie dann dem Antriebssystem zuzufuhren. 

Fig. 10 zeigt einen detaillierteren Ablaufplan der Bahnregelung, wobei hier auf die bereits oben dargelegten mathema- 
tischen Zusammenhange Bezug genommen wird. Die in Bezug auf Fig. 9 dargelegten Hauptschritte des Bahnregelungs- 
vcrfahrens beinhalten somit die folgenden Teilschritte, deren Ablauf und Zusamrnenhang aus Fig. 10 ersichtlich ist. Die 
vom MeBsystem ermittelten RegelgroBen 65 (y) werden dem Beobachter 1 und dem ersten Differenzbildner 3 zugefuhrt. 
Der Differenzbildner 3 erhalt weiterhin Sollwerte 66 (w), die der Bahnbeschreibung dienen. In einem Teilschritt 67 wer- 
den aus den RegelgroBen 65 und den Sollwerten 66 die Vektoren z und e des bewegten Koordinatensystems berechnet. 
Damit ist. es im Schritt 68 rnoglich, die vom Beobachter gelieferten Zustands vektoren vom festen xy-Koordinatensystem 
in das bewegte ze-Koordinatensystem zu Lransformieren. Gleichzeitig konnen im Schritt 69 die Bahnabweichungen 
(Fehlervektoren) vom -festen xy-Koordinatensystem in das" bewegte ze-Kbordinatensy stem txansformiert werden. Es 
schlieBt sich im Schritt 70 die eigentliche Regelung an, so daB im Schritt 71 die Rucktransfonnation des durch die Re- 
gelung bereitgestellten StellgroBen vektors vom bewegten ze-Koordinatensystem in das feste xy-Koordinatensystem 
rnoglich ist. Die StellgroBen (u) werden abschlieBend im Schritt 72 zum Antriebssystem geliefcrt. 

Die im Ablaufplan gemaB Fig. 10 angegebenen Bezeichnungen sind als Vektoren zu verstehen, deren Dimension von 
dem jeweiligen Antriebssystem abhangt. Bei planaren Antrieben enthalten diese Vektoren zwei Komponenten (x, y), bei 
raumlichen Antrieben, wie beispielsweise Robotern, sind mindestens drei Komponenten (x, y, z) erforderlich bzw. n 
Komponenten fur n-achsige Antriebssysteme. Aus Fig. 10 ist auch erkennbar, daB der verwendete Beobachter weiterhin 
mit den xy-Koordinaten arbeitet, wahrend die Regelung mil ze-Koordinaten arbeitet. 

Das bewegte Koordinatensystem, d. h. die ze- Vektoren mussen angepaBt auf die gewiinschte Bewegungsbahn ausge- 
wahlt werden. Fur den Fall eines zweidimensionalen Antriebes kann der z-Vektor als Zielvektor und der e-Vektor als 
Fehlervektor verstanden werden. Das bewegte Koordinatensystem ist so zu definieren, daB der Zielvektor z im jeweili- 
gen Referenzpunkt auf der Bahn immer die Tangente zur Bewegungsbahn darstellt. Bei einer Bewegung entlang einer 
Geraden wird der Zielvektor also entlang der Bahn ausgerichtet sein. Bei einer Bewegung auf einer Kreisbahn wird der 
Zielvektor die Tangente am jeweiligen Referenzpunkt zur Bewegungsbahn darstellen. Mathematisch kann dieser Zusam- 
rnenhang wie folgt dargestellt werden: 

Bei Geraden ist 
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wobei P E den Endpunkt und 

P A den Anfangspunkt des Geradensegmentes bezeichnen. 

Der Vektor e berechnet sich dann durch die Drehung von z nach der oben angegebenen Fonncl. 
Fur Kreise ist 



e = 



p t " P » V(*. " x M ) 2 + - yj 



X I X M 



wobei P] die aktuelle Position des Antriebs und 
Pm den Mittelpunkt des Kreises darstellen. 

Fur mehrdimensionale Koordinatensysteme gilt ebenfalls, daB die Fehlervektoren e L , e 2 , . . e n _! jeweils senkrecht 
zum Zielvektor z stehen und damit eine Fehlerflache bzw. einen (n-l)-dimensionalen Fehlerraum senkrecht zum Ziel- 
vektor z aufspannen. 

Bei der praktischen Anwendung im Bahnregelsystem wird von der tatsachlichen Position des Antriebssystem auszu- 
gehen sein. Der (erste) Fehlervektor e kann bestimmt werden, indem ausgehend von der tatsachliche Position das Lot auf 
die gewollte Bewegungsbahn gefallt wird. Durch einfache Berechnung kann der zu diesem Fehlervektor e senkrechte 
Zielvektor z ermittelt werden. AnschlieBend konnten bei rnehrdimensionalen Koordinatensystemen die weiteren e- Vek- 
toren (also Fehlerabweichungen in den anderen Dimensionen) bestimmt werden. Wird allerdings der Fehlervektor in der 
dargestellten Weise durch Ermittlung des Lots ermittelt, ergibt sich per Definition des Lotes, daB der FuBpunkt des Lots 
und die tatsachliche Position auf einer Geraden liegen, deren Richtung senkrecht zur Richtung der Bahn ist. Wird dann 
der Fehlervektor in dieser Richtung definiert, entspricht die tatsachliche Position der Summe aus FuBpunkt und Abstand, 
multiplizicrt mit dem Fehlcr- Vektor. Die verbleibcnden (n-2) Fehlervektoren werden aufgrund dieser Definition des (er- 
sten) Fehler vektors immer Null sein. Dies ergibt den besonderen Vorteil, daB die Bewegung unabhangig von der Dimen- 
sion des Raumes, in dem die Bewegung stattfindet, immer mit nur zwei Reglern geregelt werden kann, namlich einem 
Richtungsregler (z-Regler) und einem Abweichungsregler (e-Regler). Gerade bei Mehrachsenantriebssystemen fuhrt 
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dies zu einer deutlichen Re^Hferung des Regelaufwands. 

Dieses Vorgehen ist in vereinfachter Weise in Fig. 11 dargestellt, am Beispiel der Bewegung entlang eines Kreisbor 
gensegments. An dieser Stelle sei nochmals auf den Zusammenhang zu dem in Bezug auf Fig. 4 erlauterten Regelsystem 
verwiesen. 

Wenn eine kreisbogenformige Bahn gemaB Fig. 1 1 vom Antriebssystem abgefahren werden soli, wird es besonders 
nutzlich sein, die Beschleunigungsvorsteuerung zu nutzen, die fiir den Fall der Kreisbahn dargestellt werden kann: 

^ eyorsteuerung ^ 

Die Zielkomponente (Index z) entspricht hier der Tangentialkomponente und die Fehlerkornponente (Index e) ent- 
spricht der Radialkomponente der Bewegung. Die Beschleunigungsvorsteuerung im Abweichungsregelkreis ergibt sich 
somit aus der im Richtungsregler beobachteten Geschwindigkeit (v z ) und dem durch die Referenzpunkte gegebenen Ra- 
dius (r) der Kreisbahn. 

Patentanspriiche 



10 



15 



1. Regelsystem fiir elektrische Antriebe, umfassend: 

- einen Beobachter (1), derein erstes Antriebsausgangssignal (dy) und ein erstes Antriebseingangssignal (du) 
empfangt und ein erstes Zustandsanderungssignal (y) und ein zweites Zustandsanderungssignal (a) ausgibt;_ _20 

- einen ersten Regelverstarker (4), def von einem ersten Differenzbildner (3) i ein aus dem ersten Antriebsaus- 
gangssignal (y) und einem ersten Vorgabesignal (w) gebildetes Differenzsignal empfangt; 

- einen zweiten Regelverstarker (5); und 

- einen dritten Regelverstarker (6); 

wobei die Ausgangssignale der Regelverstarker (4-6) zum Antriebseingangssignal zusammengesetzt werden, da- 25 
durch gekennzeichnet, daB die Zusammensetzung der Ausgangssignale der Regelverstarker erfolgt, in dem: 

- ein zweiter DifTerenzbildner (11) ein Differenzsignal aus dem ersten Zustandsanderungssignal (v) und dem 
Ausgangssignal des ersten Regelvcrstarkers (4) bildet und dieses dem zweiten Regelverstarker (5) einspeist; 
und 

- ein dritter Differenzbildner (12) ein Differenzsignal aus dem zweiten Zustandsanderungssignal (a) und dem 30 
Ausgangssignal des zweiten Regelverstarkers (5) bildet und dieses dem dritten Regelverstarker (6) einspeist. 

2. Regelsystem nach Anspruch 1, dadurch gekennzeichnet, daB 

- der Antrieb einen gemessenen Positionssignalvektor (y) ausgibt, dessen Anderung das erste Antriebsaus- 
gangssignal (dy) darstellt; 

- der Antrieb einen vom Reglersystcm gelieferter Stromsignalvektor (u) empfangt, dessen Anderung das erste 35 
Antriebseingangssignal darstellt; 

- das erste Vorgabesignal (w) ein Positionsvorgabevektor ist; 

- das erste Zustandsanderungssignal (v) ein Positionsanderungssignal ist; und 

- das zweite Zustandsanderungssignal (a) ein Geschwindigkeitsanderungssignal ist. 

3. Regelsystem nach Anspruch 2, dadurch gekennzeichnet, daB: 40 

- zwischen erstem Regelverstarker (4) und zweitem Differenzbildner (11) ein zweiter Begrenzer (13) einge- 
schaltet ist; 

- zwischen zweitem Regelverstarker (5) und drittem Differenzbildner (12) ein dritter Begrenzer (14) einge- 
schaltet ist; und 

- am Ausgang des dritten Regelvcrstarkers (6) unmittelbar ein vierter Begrenzer (15) angekoppelt ist. 45 

4. Regelsystem nach Anspruch 3, dadurch gekennzeichnet, daB 

- der zweite Differenzbildner (11') einen weiteren addierenden Eingang besitzt, an welchem ein Geschwindig- 
keitsvorsteuersignal eingespeist wird; und 

- der dritte Differenzbildner (12') einen weiteren addierenden Eingang besitzt, an welchem ein Beschleuni- 
gungsvorsteuersignal eingespeist wird. 50 

5. Regelsystem nach Anspruch 3, welches fiir die Regelung elastischer Systeme geeignet ist, dadurch gekennzeich- 
net, daB: 

- der Beobachter (1) weiterhin ein drittes und ein viertes Zustandsanderungssignal (vD, aD) bereitstellt, die 
die Anderungen der elastischen Komponenten des Antriebs reprasentieren; 

- ein vierter Differenzbildner (50) ein Differenzsignal aus dem Ausgangssignal des vierten Begrenzers und 55 
dem dritten Zustandsanderungssignal (vD) des Beobachters bildet und dieses an einen vierten Regelverstarker 
(52) abgibt; 

- ein funfter Differenzbildner (51) ein Differenzsignal aus dem von einem ftinften Begrenzer (54) begrenzten 
Ausgangssignal des vierten Regelverstarkers (52) und dem vierten Zustandsanderungssignal (aD) des Beob- 
achters bildet und dieses an einen funften Regelverstarker (53) abgibt, dessen Ausgangssignal iiber einen sech- 60 
sten Begrenzer (55) als Antriebseingangssignal bereitgestellt wird. 

6. Regelsystem nach Anspruch 3, welches fur die Regelung von Antriebssystemen mit beliebig vielen Zustandsva- 
riablen geeignet ist, dadurch gekennzeichnet, daB 

- der Beobachter (1) fur jede Zustandsvariable ein Zustandsanderungssignal bereitstellt, das die Anderungen 

der jeweiligcn Zustandsvariable rcprascnticrt; 65 

- fur jede Zustandsvariable ein weiterer Differenzbildner, ein Differenzsignal aus dem Ausgangssignal des 
vorhergehenden Begrenzers und des vorhergehenden Zustandsanderungssignals des Beobachters bildet und 
dieses an einen weiteren Regelverstarker abgibt, wobei der letzte Regelverstarker in dieser Kaskade an einen 
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koppelt ist, der ein begrenztes Ausgangssignal als AnT^ffseinganssignal bereitgestellt. 

7. Regelsystem nach einem der Anspruche 1 bis 6, dadurch gekennzeichnet, daB es zumindest teilweise durch einen 
befehlsgesteuerten Rechenprozessor realisiert ist. 

8. Verfahren zur Bahnregelung eines elektrischen Antriebs, dessen mogliche Bewegungsbahnen in einem festen 
Koordinaten system der Dimension n liegen, insbesondere unter Anwendung eines Regel systems gemaB einem der 
Anspruche 1 bis 7, die folgenden Schritte umfassend: 

- Bestimmung eines Sollpunktes auf einer vorgegebenen Bewegungsbahn im festen Koordinatensystem; 

- Bestimmung eines mitbewegten Koordinatensystem (61) in diesem Sollpunkt, welches durch einen Zielvek- 
tor (z) und mindestens einen Fehlervektor (e) definiert ist, wobei der Zielvcktor tangential zur vorgegebenen 
Bewegungsbahn verlauft und jeder Fehlervektor senkrecht zum Zielvektor steht; 

- Bestimmung der Abweichung (62) zwischen der aktuellen Position des Antriebs und der vorgegebenen Be- 
wegungsbahn innerhalb des mitbewegten Koordinatensystems; 

- Bestimmung des erforderlichen StellgroBenvektors (63) zum Ausgleich der bestimmten Abweichung; 

- Riicktransformation (64) des StellgroBenvektors in das Teste Koordinatensystem des Antriebs; 

- Ansteuerung des Antriebs mil dem rucktransformierten StellgroBenvektor. 

9. Verfahren nach Anspruch 8, die folgenden Schritte umfassend: 

- Bestimmung einer Bewegungsbahn (60) im festen Koordinatensystem durch Aufteilung der Bahn in meh- 
rere Bahnsegmente und Bestimmung mehrerer Referenzpunkte; 

- Bestimmung des aktuellen Sollpunktes auf der Bewegungsbahn durch Fallen des Lotes von der aktuellen 
-Position des Antriebs auf dic.Bewegungsbahn; . 

- Bestimmung des mitbewegten Koordinatensystems (61), welches durch den Zielvektor (z) und den minde- 
stens einen Fehlervektor (e) definiert ist, wobei der Ursprung des mitbewegten Koordinatensystems im Soll- 
punkt auf der Bewegungsbahn liegt; 

- Bestimmung (62) des Abstands des aktuellen Sollpunkts zum Endpunkt des Bahnscgments als Abweichung 
in Richtung des Zielvektors (z) und des Abstands der aktuellen Position des Antriebs zum aktuellen Sollpunkt 
als Abweichung in Richtung der Fehlervektoren (e); 

- Bestimmung des erforderlichen StellgroBenvektors (63) zum Ausgleich der bestimmten Abweichungen; 

- Riicktransformation (64) des StellgroBenvektors und Ansteuerung des Antriebs. 

10. Verfahren nach Anspruch 9, dadurch gekennzeichnet, daB der erste Fehlervektor (e) im Sollpunkt parallel zum 
Lot von der aktuellen Position des Antriebs auf die Bewegungsbahn liegt. 

1 1 . Verfahren nach einem der Anspruche 8 bis 10, dadurch gekennzeichnet, daB auBer dem Zielvektor (z) und dem 
ersten Fehlervektor bis zu n-2 weitere Fehlervektoren bestimmt werden, so daB das mitbewegte Koordinatensystem 
maximal die Dimension n aufweist. 



Hierzu 8 Seite(n) Zeichnungen 
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